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REMOTE MANIPULATOR SYSTEM STEERING CAPABILITY FOR SVDS 


1 . INTRODUCTION 

The purpose of this document is to present the details of the Remote Manipu- 
lator System (RMS) steering capability to be implemented into the Space 
Vehicle Dynamics Simulator (SVDS). The resolve rate Uw (ref. 1) is included 
as part of the overall steering capability. The steering model includes 
eight modes: three automatic, four manual augmented, and a single joint rate 

mode. 

The automatic modes have an operator-specified final position and orientation 
of the RMS end effector in the orbiter reference frame. Mode 1, the position 
mode, determines the RMS joint angle rate commands to be the time average 
value of the difference between the final RMS angles minus the initial RMS 
angles such that no joint angle rate exceeds its limit value. Mode 2, closed 
loop-velocity mode, commands the RMS joint angle rate commands such that the 
tip of the end effector translates in a straight line and rotates at a con- 
stant rate to simultaneously reach the specified final end effector condi- 
tions. Mode 2 corrects any steering errors; Mode 3, open-loop velocity mode, 
uses the initial solution of Mode 2 and does not correct. 

The manual augmented modes correspond to the operator-specified hand con- 
troller inputs of desired translational and rotational velocities. The four 
selections of the coordinate frames for the velocity commands are: Mode 4, 

the orbiter frame; Mode 5, the end effector frame; Mode 6, the payload frame; 
and Mode 7, a mixed frame with rotational velocity in the payload frame and 
translational velocity in the orbiter frame. Mode 8, the single joint rate 
mode, enables one RMS joint to be moved while the remaining joints are held 
at their initial values. 

The steering model is formulated from references 2 and 3 with acceleration/ 
deceleration taken into account for all modes. 


Section 2 presents a brief overview of the Wl** steering model capability as 
It Is proposed for SVDS Interface. Section 3 contains detailed engineering 
flow diagrams of the RMS steering model. 
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2. SVDS-RMS STEERING INTERFACE 


The RMS steering capability to be Implemented Into the SVDS program (fig. 1} 
will provide the commanded RMS joint angle rates for all modes. The kinematic 
capability given In reference 1 Is Included within the RMS steering model. 

The RMS steering capability will be Interfaced with other modules such as 
RMS rigid body and flexible body dynamics and RMS servo modules. 

The RMS steering capability Is interfaced at four places: (1) Arm Inltlali- 
z'tlon for a case; (2) Phase initialization of simulated operator Inputs; 

(3) RMS steering via commanded joint angle rates to the Integration driver; 
and (4) Termination phase time (ETA) which is computed 1n the automatic 
steering modes and Input for the other modes. 
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Fjlgure Overview of proposed SVDS with W1S steering capability. 
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3. ENGINEERING FLOWCHARTS 


This section contains flowcharts of the subroutines to be Introduced Into 
SVDS to provide RMS steering capability. These flowcharts use engineering 
symbols and form the base for the routines to be coded or rearranged In SVDS. 
The purpose of this section Is to provide logic flow In a terminology more 
familiar to an engineer than FORTRAN code. Definition of symbols used are 
Included at the end of this section. 


SUBROUTINE AVCLMT 

Subroutine AVCLMT checks the comnanded translational and rotational 
velocities of the end effector against the acceleration and velocity 
limits. If a velocity exceeds Its velocity or acceleration limit, this 
subroutine sets It equal to the limit. 





COMPUTE ACCELERATION VECTORS 
{^C> * - {V} 

{a^} * {«^} - {uj} 





SUBROUTINE ENDORI 


Subroutine ENDORI computes the desired orientation of the end effector In 
the orblter system from a set of Euler angles specified. The order of 
rotation Is azitmjth/yaw, elevation/pitch, and roll. 






S UBROUTINE ERATES 

Subroutine ERATES computes the rotational and translational velocity of 
the end effector based on the Joint angle rates using the resolved rate 
law. 



■ • -{B-. 




SUBROUTINE JACOBI 


Subroutine JACOBI computes the Jacobian matrix from the current joint 
angles. 
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180° ROTATION REQUIRED 
COMPUTE ROTATION AXIS 
[T] = [B] - n 

U^ = i=l,2,3 


DETERMINE LARGEST 

COMPONENT OF {U } 

(0 


LET U BE THE LARGEST COMPONENT, 

Uir, 


THEN 



i fK 






SUBROUTINE LNKAGE 


Subroutine LNKAGE confutes the end effector position and orientation 
relative to the orbiter. The transpose of the orbiter to wrist pitch 
orientation 1s saved for use by subroutine JACOBI. If a payload Is 
attached (PA » 1), the payload center and orientation are computed. 



14 




15 




SUBROUTINE MSTEER 


Subroutine MSTEER is the main subroutine that computes the commanded joint 
steering rates of the RMS arm. Based on the value of MODE, the specific 
steering Is executed. 
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SUBROUTINE OPERIN 


Subroutine OPERIN computes the initial values at the beginning of each phase, 
depending on the values of MODE. If MODE ” 1, automatic position steering is 
selected. If MODE * 2 or 3, automatic velocity steering is selected (closed 
loop by MODE = 2 or open loop by MODE =3). If MODE * 4, 5, 6, or 7, manual 
augmented steering is selected with the reference frame selected as orbiter 
by MODE = 4, end effector by MODE = 5, payload by ^WDDE = 6, or mixed by MODE 
= 7. For the automatic steering, Sj = 1 implies that the Euler angles are 
being input in the orbiter reference frame rather than the transformation 
matrix. If MODE = 8, single joint rate steering is selected. 
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SUBROUTINE ORIEND 


Subroutine ORIEND computes the Euler angles contained in the specified 
desired orientation of the end effector provided as the transformation 
matrix from the orbiter system. The Euler angles represent the order of 
rotation of azimuth/yaw, elevation/pitch, and roll in the orbiter system. 



( RETURN 





SUBROUTINE RATLMT 


Subroutine RATLMT checks each commanded jotnt rate against its limit. If 
one or more limits are exceeded, the commanded joint rates are reduced pro- 
portionally so that one commanded joint rate equals its limit, and the others 
are within limits. 






SUBROUTINE RMANGS 


Subroutine RMANGS computes the RMS joint angles, given the position and 
orientation of the end effector relative to the orbiter. 





m 
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SUBROUTINE RMSIST 

Subroutine RMSIST computes the initial state variables of the remote 
manipulator arm. If the input is position and orientation* the joint 
angles are ccmputed. 







SUBROUTINE RMSRAT 

Subroutine RMSRAT computes the joint angle rates compatible with the com- 
manded rotational and translational velocity of the end effector using the 
resolved rate law. 
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SUBROUTINE VCLOSE 

Subroutine VCLOSE computes the times of deceleration and maximum velocity 
for llne-of-sight and angle-of-sight closed-loop steering. Depending on 
the maximum time of either the llne-of-sight or angle-of-sight steer to 
reach the final state, the other steering Is set proportional, preserving 
Its deceleration time period. Effectively, both accelerations and decelera- 
tions will be at maximum values at the start and termination of the phase. 
Rate and velocity limiting will cause the phase to be automatically extended. 
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SUBROUTINE VOTRAN 

Subroutine VOTRAN transforms the commanded rotational and translational 
velocities to the orbiter system. For open-loop velocity steering (NODE»3), 
the commanded velocities are limited during acceleration and deceleration 
phases. 
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SUBROUTINE VTOPEN 

Subroutine VTOPEN computes the times fo ecceleratlon and maximum velocity / 

for llne-of-sight and angle-of -sight open-loop steering. Depending on the 
maxinwm time of either the l1ne-of-s1ght or angle-of-sight steering to reach 
the final state, the other steering Is set proportional, preserving Its 
acceleration time periods. 
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DEFINITIONS OF SYMBOLS 


[B] 


IB17] 


[B27] 


DT 

CK 

ETA 

ETAP 

IFO 


Coefficients of the Jacobian used In the resolved rate law 

Transforniation matrix from Initial orientation of the end effector 
to the final 

Transformation matrix from final desired end effector orientation to 
orbiter bo4y system 

Column matrix of the commanded end effector angular velocity relative 
to the orbiter expressed in the wrist pitch system 

Column matrix of the components of the commanded end effector 
translational velocity relative to the orbiter expressed in the 
wrist pitch system 

Transformation matrix from the end effector system to the longeron 
system 

Transformation matrix from the end effector system to the shoulder 
yaw system 

Integration step size 

Cosine value using the law of cosines 

Estimated time of the current maneuver 

Estimated time to complete the angular rotations specified for the 
end effector at maximum angular velocity 

Flag Indicating whether the Initial orientation of the RMS is to be 
specified by the position and orientation of the tip of the end 
effector In the orbiter body system (=0) or by joint angles and 
joint angle rates (=1) 

Distance from the RMS attach point to shoulder pitch pivot point 
Length of upper arm 
Length of lower arm 
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■“S 

MODE 


PA 

{r} 






^-^6B> 


^^6Bp> 




R 

0 ) 


Distance from wrist pitch joint to wrist yaw joint 
Distance from wrist yaw joint to the tip of the end effector 

Flag indicating the particular steering desired: 

(1) Automatic steering, positi n mode; 

(2) Automatic steering, closed-loop velocity mode; 

(3) Automatic steering, open-loop velocity mode; 

(4) Manual augmented steering, orbiter frame; 

(5) Manual augmented steering, end effector frame; 

(6) Manual augmented steering, payload frame; 

(7) Manual augmented fleering, mixed-rotations in payload frame 
and translations in orbiter frame; 

(8) Single joint rate steering mode 

Flag indicating that a payload is attached (=1) 

Column matrix of the components of position vector from the shoulder 
pitch joint to the wrist yaw joint expressed in the longeron system 

Temporary column matrix of the components of position vector from 
the center of mass (CM) of the orbiter to different joints in the 
orbiter body system 

Ratio used to scale down the commanded translational velocity 

Column matrix of the components of the position vector from the CM 
of the orbiter to the RMS attach point in the orbiter body system 

Column matrix of the components of the position vector from the CM 
of the orbiter to the tip of the end effector in the orbiter body 
system 

Column matrix of the components of the position vector from the CM 
of the orbiter to the final desired position of the tip of the end 
effector expressed in the orbiter body system 

Column matrix of the components of the position vector from the CM 
of the orbiter to the CM of the payload in the orbiter body system 

Ratio used to scale down the commanded angular velocity 
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RATIO Ratio used to scale down commanded velocities or commanded joint 
angle rates 

Sj Flag Indicating whether the specified final orientation of the end 

effector Is a transformation matrix (= 0 ) or Euler angles (* 1 ) In the 
orbiter body system 

I 

t Time from start of acceleration or time remaining for deceleration 

In the open-loop velocity steering mode 

[Tgnjl T«nporary transformation matrix from the various RMS joint systems 
to the orbiter body system 

[Tbs! Transformation matrix from the wrist pitch system to the orbiter 
body system 

[Tgy] Transformation matrix from the end effector system to the orbiter 
body system 

[Tggl Transformation matrix from the payload system to the orbiter body 
system 

[Tj^gl Transformation matrix from the orbiter body system to the longeron 
system 

ty^ Phase time to stop constant acceleration and start constant 

translational velocity commands 

ty2 Phase time to stop constant translational velocity commands and 

start constant deceleration 

[T^{ 0 )] Transformation matrix representing a 6 rotation about the l-ax 1 s 

112(0)3 Transformation matrix representing a 0 rotation about the 2 -ax 1 s 

113(0)3 Transformation matrix representing a 0 rotation about the 3 -axis 

[Tygl Transformation matrix from the payload system to the end effector 

system 

t^.j Phase time to stop a constant acceleration and start constant 
angular velocity conmands 
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Phase time to stop constant angular velocity commands and start 
constant deceleration 

TP Actual phase tin« 

{Uy} Column matrix representing the Unit vector along the line of sight 

{U^} Column matrix representing the unit axis of rotation vector 

{V} Column matrix of components of the actual translational velocity 

expressed in the orbiter body system 

{V^} Column matrix of components of the commanded translational velocity 
expressed in the orbiter body system 

I 

{Vj*} Column matrix of components of the commanded translational velocity 
in the system specified by MODE 

{V^} Column matrix of components of commanded minus actual translational 

velocity expressed in the orbiter body system 

Maximum translational velocity of the end effector relative to the 
orbiter 

Maximum translational acceleration of the end effector relative to 
the orbiter 

a Parameter used in arm angle initialization computations 

a Parameter used in arm angle initialization computations 

Y Parameter used in arm angle initialization computations 

AV Distance from current position of the end effector to final desired 

position of the end effector 

Aw Rotation angle from current orientation of the end effector to final 

desired orientation of the end effector 

e<| Shoulder yaw angle 

62 Shoulder pitch angle 

0 ^ Elbow pitch angle 
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Wrist pitch angle 

8g Wrist yaw angle 

e. Hand roll angle 

0 

{Sp) Column matrix of final desired Joint angles 

{0} Column matrix of actual or commanded joint angle rates 

{0q} Column matrix of commanded joint angle rates 

. • 

{0J.} Column matrix of specified commanded joint angle rates 

{0j^} Column matrix of maximum commanded joint angle rates 

Final desired roll angle of the end effector In the orbiter body 
system 

^2 Pinal desired elevation (pitch) angle of the end effector In the 

orbiter body systan 

Final desired azimuth (yaw) angle of the end effector In the 
orbiter body system 

(u)} Column matrix of components of the actual angular velocity 

expressed in the orbiter system 

{Wj,} Column matrix of components of the commanded angular velocity 
expressed In the orbiter system 

I 

(u)^} Column matrix of components of the commanded angular velocity in 
the system specified by MODE 

{wj,} Column matrix of components of commanded minus actual angular 
velocity expressed In the orbiter body system 

Maximum angular velocity of the end effector relative to the 
orbi ter 

Maximum angular acceleration of the end effector relative to the 
orbiter 
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